A family of asymptotically stable control laws for flexible robots based on a passivity approach

A general family of asymptotically stabilizing control laws is introduced for a class of nonlinear Hamiltonian systems. The inherent passivity property of this class of systems and the Passivity Theorem are used to show the closed-loop input/output stability which is then related to the internal state space stability through the stabilizability and detectability condition. Applications of these results include fully actuated robots, flexible joint robots, and robots with link flexibility

Gait generation via intrinsically stable MPC for a multi-mass humanoid model

We consider the problem of generating a gait with no a priori assigned footsteps while taking into account the contribution of the swinging leg to the total Zero Moment Point (ZMP). This is achieved by considering a multi-mass model of the humanoid and distinguishing between secondary masses with known pre-defined motion and the remaining, primary, masses. In the case of a single primary mass with constant height, it is possible to transform the original gait generation problem for the multi-mass system into a single LIP-like problem. We can then take full advantage of an intrinsically stable MPC framework to generate a gait that takes into account the swinging leg motion

Passivity/Lyapunov based controller design for trajectory tracking of flexible joint manipulators

A passivity and Lyapunov based approach for the control design for the trajectory tracking problem of flexible joint robots is presented. The basic structure of the proposed controller is the sum of a model-based feedforward and a model-independent feedback. Feedforward selection and solution is analyzed for a general model for flexible joints, and for more specific and practical model structures. Passivity theory is used to design a motor state-based controller in order to input-output stabilize the error system formed by the feedforward. Observability conditions for asymptotic stability are stated and verified. In order to accommodate for modeling uncertainties and to allow for the implementation of a simplified feedforward compensation, the stability of the system is analyzed in presence of approximations in the feedforward by using a Lyapunov based robustness analysis. It is shown that under certain conditions, e.g., the desired trajectory is varying slowly enough, stability is maintained for various approximations of a canonical feedforward

Stable Torque Optimization for Redundant Robots Using a Short Preview

We consider the known phenomenon of torque oscillations and motion instabilities that occur in redundant robots during the execution of sufficiently long Cartesian trajectories when the joint torque is instantaneously minimized. In the framework of online local redundancy resolution methods, we propose basic variations of the minimum torque scheme to address this issue. Either the joint torque norm is minimized over two successive discrete-time samples using a short preview window, or we minimize the norm of the difference with respect to a desired momentum-damping joint torque, or the two schemes are combined together. The resulting local control methods are all formulated as well-posed linear quadratic problems, and their closed-form solutions also generate low joint velocities while addressing the primary torque optimization objectives. Stable and consistent behaviors are obtained along short or long Cartesian position trajectories, as illustrated with simulations on a 3R planar arm and with experiments on a 7R KUKA LWR robot

MPC-based humanoid pursuit-evasion in the presence of obstacles

We consider a pursuit-evasion problem between humanoids in the presence of obstacles. In our scenario, the pursuer enters the safety area of the evader headed for collision, while the latter executes a fast evasive motion. Control schemes are designed for both the pursuer and the evader. They are structurally identical, although the objectives are different: the pursuer tries to align its direction of motion with the line- of-sight to the evader, whereas the evader tries to move in a direction orthogonal to the line-of-sight to the pursuer. At the core of the control architecture is a Model Predictive Control scheme for generating a stable gait. This allows for the inclusion of workspace obstacles, which we take into account at two levels: during the determination of the footsteps orientation and as an explicit MPC constraint. We illustrate the results with simulations on NAO humanoids

A new separation result for Euler-Lagrange-like systems

This paper presents a separation result for some global stabilization via output feedback of a class of quadratic-like nonlinear systems, under the form of some stabilizability by state feedback on the one hand, and unboundedness observability on the other hand. They allow to design, for any domain of output initial condition, a dynamic output feedback controller achieving global stability. As an example, these conditions are shown to be satisfied by so-called Euler-Lagrange systems, for which a tracking output feedback control law is thus proposed

Humanoid gait generation for walk-to locomotion using single-stage MPC

We consider the problem of gait generation for a humanoid robot that must walk to an assigned Cartesian goal. As a first solution, we consider a rather straightforward adaptation of our previous work: An external block produces high-level velocities, which are then tracked by a double-stage intrinsically stable MPC scheme where the orientation of the footsteps is chosen before determining their location and the CoM trajectory. The second solution, which represents the main contribution of the paper, is conceptually different: no high-level velocity is generated, and footstep orientations are chosen at the same time of the other decision variables in a singlestage MPC. This is made possible by carefully redesigning the motion constraints so as to preserve linearity. Preliminary results on a simulated NAO confirm that the single-stage method outperforms the conventional double-stage scheme

Feasibility-Driven Step Timing Adaptation for Robust MPC-Based Gait Generation in Humanoids

The feasibility region of a Model Predictive Control (MPC) algorithm is the subset of the state space in which the constrained optimization problem to be solved is feasible. In our recent Intrinsically Stable MPC (IS-MPC) method for humanoid gait generation, feasibility means being able to satisfy the dynamic balance condition, the kinematic constraints on footsteps as well as an explicit stability condition. Here, we exploit the feasibility concept to build a step timing adapter that, at each control cycle, modifies the duration of the current step whenever a feasibility loss is imminent due, e.g., to an external perturbation. The proposed approach allows the IS-MPC algorithm to maintain its linearity and adds a negligible computational burden to the overall scheme. Simulations and experimental results where the robot is pushed while walking showcase the performance of the proposed approach

Robust MPC-Based Gait Generation in Humanoids

We introduce a robust gait generation framework for humanoid robots based on our Intrinsically Stable Model Predictive Control (IS-MPC) scheme, which features a stability constraint to guarantee internal stability. With respect to the original version, the new framework adds multiple components addressing the robustness problem from different angles: an observer-based disturbance compensation mechanism; a ZMP constraint restriction that provides robustness with respect to bounded disturbances; and a step timing adaptation module to prevent the loss of feasibility. Simulation and experimental results are presented